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(57) Abstract: A robot collaboration control system includes communication means (21) constituting a network by connecting a 
plural ity of control devices (Ca, Cb) for controlling the operation of each of a plurality of robots (Ra, Rb) in a communicable manner, 
input means (37a, 37b) provided on each of 
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DM, DZ, EC, EE, ES, FI, GB, GD, GE, GH, GM, HR, HU, 
ID, IL, IN, IS, KE, KG, KP, KR, KZ, LC, LK, LR, LS, LT, 
LU, LV, MA, MD, MG, MK, MN, MW, MX, MZ, NO, NZ, 
OM, PH, PL, PT, RO, RU, SC, SD, SE, SG, SI, SK, SL, TJ, 
TM, TN, TR, IT, TZ, UA, UG, US, UZ, VC, VN, YU, ZA, 
ZM, ZW. 

(84) fg£§ ARIPO (GH, GM, KE, LS, MW, 

MZ, SD, SL, SZ, TZ, UG, ZM, ZW), =7 S/7fti¥ 
(AM, AZ, BY, KG, KZ, MD, RU, TJ, TM), 3 — □ V /i 
(AT, BE, BG, CH, CY, CZ, DE, DK, EE, ES, FI, FR, 
GB, GR, IE, IT, LU, MC, NL, PT, SE, SK, TR), OAPI # 



Sr" (BF, BJ, CF, CG, CI, CM, GA, GN, GQ, GW, ML, MR, 
NE, SN, TD, TG). 



the control devices for inputting operation instructions for each robot, and timing generating means (69a, 69b). Each of the control 
devices is set to an independent function execution mode, a master function execution mode, or a slave function execution mode. 
Among the plurality of control devices, the control device (Ca) which is to perform master operation is set to the master function 
execution mode and the remaining control device (Cb) is set to the slave function execution mode. While correcting the minimum 
interrupt cycle (Ts(b)) of the slave side control device (Cb), the control time (tall, tal2, tal3) of the master robot (Ra) by the master 
side control device is delayed by a predetermined time (T) so as to perform collaborating operation. Thus, it is possible to always 
maintain a plurality of robots in a synchronized state, thereby preventing a disagreement between operations of the robots. 
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H8Bs v**n#y h©Ki#^'P^Mi{3^-rS7l/-7D^^ hOUjff 

Y^^D^'^fcU iJOP^f hRb^7U-7D^^y h^bfcilts V7 
*p#y h£J;t>*7l/— 7"D#y h©^5ijffi^SOt:*5VN-C> -rztutfy b 

0 JC&UT 7 1/ -7n * y h R b ©ft^M*^** S s ^ S&fWT^tf S e T-tfc^ 
£frlfc£-fSo ^7*D#y bRa©$(^MsfrkMe^©^ljt'&£^ V 
7#P#y bRa®itlft'P^MifcM^1-?>7l/-7D7}fvy hRbcDtt^*^ 
j&S i ^^<i!2)So 
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fcSOSU s = 0. 0®t%M)ftmTf&Me\zmM?Zb®t*r%o Hits 
(s) i:U T^^D^y hRaOi^7^Me*>^ V— hRb© 

s&f^»T^©*»ff?!i*TAB (e) tu Kftx-mirba) £?%><> 

Tab (s) =S s - Ms" 1 ••• (14) 

Tab (e) =S e - Me- 1 - (15) 

*fc±IB© ! &*lftff^!ITAB (s) s Tab (e) £X Y Z Or 4 =7— &T*&.tBTZ 
Tab (s) (Xs, Ys. Zs, Os, As, Ts) £U Tab (e) 
& (Xe, Ye, Ze, Oe, Ae, Te) tLX^ ^^D^yhRaOlff 

Xi=Xe - (Xe-Xs) -s -(16) 

Yi = Ye - (Ye-Ys) -s —(17) 

Z i = Z e- (Z e-Z s) • s - (18) 

O i = Oe- (Oe-Os) -s -(19) 

Ai=Ae- (Ae-As) -s -(20) 

Ti = Te - (Te-Ts) -s -(21) 

C*ie>CD5i;l 4-1 9**ftff?!IT i k*BBU T**n#y hRaO^Jfc 
4»^Mi{c^ri-^^l/-^n^y h Rb©t&ft^tt'^S i 8\ 

S i = T i • Mi - (22) 

CO«t^m^D'H5'hRa0ft^^Mi(:^n7l/-yD!|?y hR 
b©Sb#^4'^S i©H^5C«> «ffiHI«|Ca, Cb©^U45a, 4 5b 
fcrn^AfcbTtellfl&tlTfctK ftxE-rS«fc-5fcx #D^^hRa, Rb® 

Z> Z t tfi t? & S "5 fc^te tbT l> S o 
H19»s ttBtt^aJttftft^t-i^Mftttlllit-Sfci&O^D^ry hRa, Rb 
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^D^^y h©T-Aft$»fr9 4b0^lb^m^^-ro EllOii, E9Jc^£;ft, 
tz &b<DW>mW}ft7V 7? ACD-m^l" HIT* & 3 o 

P^A&, -#©Ptf y hRa^J^TfltT^ftST'P^A r. PROGRAM ma 
ster( )j ts flfc&ODatfy hRbtiot^W/D^A r. PROGRAM 
slave( )j ^AH^^n^o 

-^©P^y hRafilfc^^ti?)7"P^7A r.PRORAM. master( )j B\ 1 
~2 0©;*^y:7"£:£U El9 ©^T-^^ti^t&ftaMfiPm0^^=g-i1i 
ttIPml~Pm9«SM7ti[IPal 0£M£tW^ -£©Ptf«.y b 
Rafd^fi^-frSfctf)^ ft©«k-5 £4i$£ft3o 

Sfs J^yrrifciu -#©P#y bRaCD#W^lti#Pl^mPmO-s^Sj 
mt&tztiXDMftifr^rzftbs tjmove #lcl#0j i;X*^n?»o rjMOVEj &p* 
yh^lfcl *H&S ^©=&$fl ©If H§ Krtt £ *5 £ ^ til £ ■£ S «> ©ifr^T* & 

Xr^72{t gjfTOS&fi P m 0 *p S> &© P m 1 ^-£©P *yt- 
Ra£^®j£#3fc&©iSr^rT:&Ds r LM0VE #lcl#lj k.Ajj£H%>o TLMOVEj 
»B»#^m^-r§^f§Tfet)s r#id#lj (i|gftgPmU»^ 

^^^7°3}i, luIB^^^7°2T*J^bfe{5ifiPml"tr>'\> h* 3 0£SBi;&-tf 
3fc#>©i*H^&?K r CL0SEj i:IEf8£*l3o J-M77^D^'nRa0fi 

^r>yr4^ ■g5lli)^^^m-rs^T-fet)s TMASTERj £IB*8£;h, 

©o^y hRbfioT'^i^-^m^^Ts MKiff^^TSo -?z*mm'tT 
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commune h (Dm^m^MmT s (to % s •*7>*mfe&ft : z-v<D 
ummm c a e> ©&^#* u - - k ©*jffli&H cbc £ t *. « 

±IBOJ:"5^3?b<i7>h*»-eA*^tvfci:§{3«> */J*!!a*J«IJB T s (b) 
£*g<U 5^j>7>f^tA*^tifci:§l:(t &/J^J&frJi&T s (b) 

yhRa^Ji^fitall, tal2, t a 1 3 , W£#>aiOTT 
td\fMM^^tmmt &£il£J;oTs ^X*D#y MlafcMt 3*l/-:7P 

^^^7°5(is T^^D^y hRat:^UT^> h* 3 0 £ia D3fctf)©tfM*"? 
fcDs >"SIGNAL 2j tIB**tlSo 
7ryr6tt, "Tufty hRb©/\> h* 3 0 SIBCSfefe©^* Dn 

•"SIGNAL 2:2j £i3«B£*i£o 

2, P s 2^&M$it%>fz®<D€is^-e$>t)s r MLLM0VE #lc2#2,#lc2#2j i:!3®£ 
■fr*fc«>©tfr^T?fctK r MLLM0VE #lcl#3,#lc2#3j k|3«*n*o 

©tfr^-efc&s tswait iooij tmmznzo 

t5*T^t5fc«)0^"Cfe!3s rswAI 2:1001j £fat&£*i£o 

^fyril^ #D^bRa, Rb^©ISttIPm4, Ps4^» 
£*£fc#>©*M*-Cfct>N O1LC1M0VE #lcl#4,#lc2#4j £f3f&£*l3o 

^fy712tts <&D*>hRa, Rbtft®iWPm5 3 Ps5a^| 
^-e-SfcaxO^TfeDs TMLC1M0VE #lcl#5,#lc2#5 j t$ZM£h%>o 

^ri3tt, §D^hRa, Rb»«IPm6, Ps6^ft 
&^£fc&©tfHrT'&tK TMLC2M0VE #lcl#6,#lc2#6j J:fBtt*H*o 

^r^rHil ^D^bRa, Rb^0l8f4IPm7, Ps7a|» 
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3-frSfcafr©#^-e&t>s TMLLMOVE #lcl#7,#lc2#7j £I3®£ft3o 

*yy715B\ #n#yhRa, RbS^OilfifPmS, Ps8^» 
£#§fc»©*H?n!&*K rMLLM0VE#lcl#8 5 #lc2#8j tmMZfrZo 

TALONEj tmMZh&o 

^7^7*1 7tts -SOD^y hRa©/N>h*3 0 £11 < fc&©*Hr£fc !K 
TOPENj hlBift^tl^o 

^fyriBlis -#©P#y hRafc*tLT\ ^'fT^^ r 1002j r-Jg 
^^nfettJB«»ja-r**T?f#«l**Sfc«>O^T?fet)s TSWAIT 1002j i:IB 

7Ty719tt, -^OP^vhRaMS r#i c i#9j -cffiw^tift B«ffi 
IPm9^Il^i^t5fcfe0^tfeDN TLMOVE #lcl#9j £f3<8&*i5o 

7fy72 0fcfcs — #©P#f hRa*»fmTffc@Pml O^M&^Sfc 
&(Df*H!rC-&tK r H0MEj i:l3«B^n^o 

ffe#©P#y hRbfcttLTKS&fts^p^Ateoi^BiiiS-rSo 
^©MOD^y fRbffl/n^A r.pRORAM slave ( )j fc* N l~10©Xf 
y7S*U 0 9©^r£^£ft£«rttg4§H&fiP s Ofr£>=&#eP sl-vPs 
9^TKlf^«lTtsigP s 1 OCSSIlffSs XW-^D^y hRbt^ff** 

£-&Sfc&©ttfNlr^'rfcDx i"jmove #lcl#0j iiX^^n^o rjMOVEj ttn# 
y h*m^bfc(ftS^©«IHi&f^fc^»tS^»*"&%fc«>©^T?&So llcl 

7s=rv 7*2 ii> ttf^H*fetteP s 0fr£>&©14gP s W1fe#©P#y hRb 
£^$j£^3fc&©ifrire<&!3s TLMOVE #lcl#lj ^I3^^tl^.o l"LM0VEj ttifc 
*»ff^-C» tK r#icl#lj &&©&SP s 1 ©MrC&3o 

^rf73tt. ttiI3X^y7-2T»^bfeMPs 1 Tv\> K 3 0 
5fc»©#^-C*Dx rCLOSEj tf3IB£ft&o JBJLt#* U—^ntfy h< 
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^ry74tts flh#©P#y hRb£«t£ r"l002j 
£^£?-&£T^£^6fcft©ifr1^& !^ rswAIT 1002j h!B*B£*i£«> 

^T*fo*K r SLAVE j i:fB*B£*l3o CL(Dy°uy^A(Dmnm^^Xl±s 

jfe»L"Ci8»lttf^* ! fT5o £©&fi3b{Wfc^ H>i^bfc«tat^ «®n^b 

7,=r^ 71 Its -ffe^CDDJjty bRb©/N> h* 3 0 £fg< fc#>©tft^rT*fc tK 
roPENj i:f3f&£ft3o 

T^^fflS'J^aS^-rSfe^O^T-fetJx rsiGNAL 2j £f3*&£*l3o 
P s 9 £ fc tb<D$t^t! & D x r LM0VE #lc2#9j £ IB« £ ft 3 e 

ttXO^tfcDx r H0MEj i:ia«*nso 

tco^Ttts grP#y h*7X^P5|?y ht^l/-/n^^ hblzmfel<Xs tu 

m^iz^Lxmmmi^mn u c a u-t * u^^ijm^s c b & ©» 
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-Kfc»b6*nfclWIPai«Cb©xai*llIK (W»I0) 4 8b*mvtfrfc:b 
ft£o Mi&fl^^T&s VX^D^y M1©^U 4 5 atI31i£tlfc7°D 

fc^ttl*©»Jffll«:N TX^P^y hRa©#J«l*!«Cafc:»W-6n*AtfJAia 
E§4 8 a£ffl^T : fT&fc>;t'U *©fc»fc#5©IBma***fc&DN XI/— :/n# 
y hRb^^4iT'ffifflb«i:a fcbfcW'&fcx ?7^D^ hEaOfi^OKfS 

±5B©HJ|g©^t?«s 2^0D^HRa, RbfcMgiJfc|ftlt&nS2^© 
IMSCa, CbS3l«igtt^®2 1 fciotiilfci^to^t^fc^ 
*H5«i©IUlS©flh©^Jtt-CI*s 3fcW±©B#y hfcffl§y£|gtt&ft3ftlW£Sg 
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m * © is a 

#f&JtW&«fc3fttte>*u luIBft/MO^ii^T-^-Y ^>^M^^^1-^^-i' 

t^tf^-H ©5 •&©<!>&<£:*> msg&m^mtfcmztiit-rtiy 1 ?* 

mm®.$k<Dmmmw® ? *> © i -^ffiBrn 9? a ©ntf t 
nff k tfftj^ftfc h ^ mtmmcDummmcD *> t>©iui3v^ *$5tm*f 

^-KfcK^tifc©J»«fl*|»<a*©*Jffll^S©5*^< fc* lo*i|5|B 
7"D^7A©^fftcJ;^T^l/-^«J#^^ff"r^^b-^ti^ff : E-KlciS 

* V - T^tB^fr^- K WLfeZ nfc»J»«s* fc J; o T $Jffll$ ft £ * 1/ - 

*ff^-KfclftS*nfcia»36«^»ff*B^ft5afiUfc^*S (ta) fr£>iiuf3* 
^yhOW^H^n^i (tb) £-e©aifii§nra (tb-ta) # N * 
«S©^f!i&#MI»3 (Ts (b) ) **'to**4£i:S«f»i:fSlil*Sl 
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3. mtt&>&&zmm (t) &s &mmmn®$mmn (w) wr^stf 
mtimr$ (tb-ta) tnmm^^xmm-r^zt^w.tr^mmmsmm 

mm-rxtmrnm'tj^- ^izwt^nmmmm^ mmmmmm^m^iff\,x 

g©? t^mm^^^m^nn^- ^^mM^ntcmmmmt, mm^^-^n 
mm^-^^^n^mnmmtit, mmmmwt^mzfrvx, mm-?* 

I££A*i£*i3 i: £ & fc s ^©^^ISfcmFfBMM^il^lS^^bTX*^^ 
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PROGRAM master() 

1 JMOVE #1c1 

2 LMOVE #1c1 

3 CLOSE 

4 MASTER 

5 SIGNAL 2 

6 SIGNAL 2:2 

7 MLLMOVE #1c1 

8 MLLMOVE #1c1 

9 SWAIT 1001 

10 SWAIT 2:1001 

11 MLC1MOVE #1c1 

12 MLC1MOVE #1c1 

13 MLC2MOVE #1c1 

14 MLLMOVE #1c1 

15 MLLMOVE #1c1 

16 ALONE 

17 OPEN 

18 SWAIT 1002 

19 LMOVE #1c1 

20 HOME 
END 



2, #1c2_2 

3, #1c2_3 

4, #1c2_4 

5, #1c2_5 

6, #1c2_6 

7, #1c2_7 

8, #1c2_8 
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PROGRAM slave() 

1 JMOVE #1c2_0 

2 LMOVE #1c2_1 

3 CLOSE 

4 SWAIT 1002 

5 SLAVE 

6 ALONE 

7 OPEN 

8 SIGNAL 2 

9 LMOVE #1c2_9 
10 HOME 

END 
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